# from tf.transformations import quaternion_from_euler
# from geometry_msgs.msg import Pose
from math import pi
from RPYPose import RPYPoser
<<<<<<< HEAD
import GripperControl
import rospy
from std_msgs.msg import Int8
from time import sleep
from ArmMove import ArmMover

# 角度转弧度
print("0")
GripperControl.newcontrol(1)
print("1")
# GripperControl.newcontrol(1)
# print("2")
=======
from RPYPose import MSGPoser
# 角度转弧度
name = 'chenpi'
msg = [0,0,0,90,0,0,0]
pos = MSGPoser.MSGToPose(msg)
print(pos)

>>>>>>> 7ab8b32aacdca90fbd07e836fad97c25c5aa0f47




